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Abstract — In  active  sonar  and  radar  applications  measure¬ 
ments  consist  of  range,  bearing  and  often  range  rate  -  all  non¬ 
linear  functions  of  the  target  state  (usually  modeled  in  Cartesian 
coordinates).  The  converted  measurement  Kalman  filter  (CMFK) 
first  converts  the  range  and  bearing  measurements  into  Cartesian 
coordinates  to  allow  for  the  use  of  a  linear  Kalman  filter.  The 
extension  of  the  CMKF  to  use  range  rate  as  a  linear  measurement 
however  has  been  limited  to  cases  with  small  bearing  errors. 
The  use  of  range  rate  as  a  nonlinear  measurement  requires 
the  use  of  a  nonlinear  filter  such  as  the  extended  Kalman  filter 
(EKF).  Due  to  the  uncertain  performance  of  the  EKF,  various 
modifications  have  been  proposed,  including  use  of  a  pseudo 
measurement,  an  alternative  linearization  of  the  measurement 
prediction  function,  and  sequentially  processing  the  converted 
position  and  range  rate  measurements  (applied  to  the  EKF  and 
the  Unscented  Kalman  Filter).  Common  to  these  approaches  is 
that  the  measurement  prediction  function  remains  nonlinear.  A 
measurement  conversion  from  range,  bearing  and  range  rate  to 
Cartesian  position  and  velocity  has  recently  been  proposed  [4]. 
This  manuscript  expands  the  evaluation  of  this  new  approach 
by  comparing  to  the  Sequential  EKF,  the  Sequential  Unscented 
Kalman  Filter  (UKF)  and  the  posterior  Cramer-Rao  lower  bound 
(PCRUB).  The  new  method  is  shown  to  have  improved  mean 
square  error  performance  and  exhibits  improved  constancy  over 
the  previously  proposed  methods,  especially  in  cases  with  poor 
bearing  accuracy. 


I.  Introduction 

A  common  tracking  scenario  is  one  in  which  the  mea¬ 
surements  consists  of  range  and  bearing  while  the  target  is 
tracked  in  Cartesian  coordinates  (a  natural  choice,  since  target 
dynamics  are  linear  in  the  Cartesian  coordinate  system).  A 
common  approach  is  to  employ  an  EKF  to  handle  the  fact 
that  the  measurements  are  a  nonlinear  function  of  the  target 
state. 

An  alternative  approach  is  to  first  convert  the  measurements 
to  Cartesian  coordinates,  allowing  the  tracking  to  be  performed 
with  a  linear  Kalman  filter.  Performance  of  this  approach, 
referred  to  as  the  Converted  Measurement  Kalman  Filter 
(CMKF),  exceeds  that  of  a  mixed  coordinate  EKF  if  an 
unbiased  conversion  from  polar  to  Cartesian  coordinates  is 
used  [14].  Performance  is  further  enhanced  if  estimation  bias 
is  eliminated  by  evaluating  the  converted  measurement  error 
covariance  using  the  state  prediction  [5]. 

In  addition  to  range  and  bearing,  in  many  active  sonar 
and  radar  applications  measurements  also  include  range  rate. 


Previous  approaches  to  incorporate  range  rate  have  converted 
range  and  bearing  to  Cartesian  coordinates,  but  left  range 
rate  as  a  nonlinear  function  of  the  state.  A  recently  proposed 
method  [4],  however,  provides  a  natural  extension  of  the 
CMKF  to  include  range  rate  by  converting  range,  bearing 
and  range  rate  to  Cartesian  position  and  velocity.  The  con¬ 
verted  measurement  is  then  used  in  a  linear  Kalman  filter. 
The  method,  referred  to  here  as  the  converted  measurement 
Kalman  filter  with  range  rate  (CMKFRR),  was  shown  in  [4] 
to  have  improved  performance  over  an  EKF  and  an  EKF  with 
alternate  linearization  as  describe  in  [3].  In  this  manuscript  the 
evaluation  is  expanded  to  include  the  sequential  EKF  using  a 
pseudo  measurement  [7],  [11],  [12]  and  the  sequential  UKF 
using  the  raw  range  range  measurement  [8],  [13], 

II.  Problem  Statement 

Active  sonar  and  radar  systems  produce  measurements  in 
polar  coordinates,  often  with  the  additional  measurement  of 
range  rate: 


ZRAW  = 


I’m 
T  m 


=  h(X) 


(1) 


where  rTO,  am ,  and  fm  are  the  measured  range,  bearing  and 
range  rate;  h  is  the  measurement  function,  and  x  is  the  target 
state.  The  measurement  error  for  the  raw  measurements  is 
assumed  to  be  Gaussian  with  covariance  matrix 

I  of  0  paraf  1 


Rraw  — 


(2) 


per  j-  o"  0 


where  oy,  ay, ,  and  ay  are  the  standard  deviations  of  the  range, 
bearing  and  range  rate  measurement  noise.  The  correlation 
coefficient  for  the  correlation  between  the  range  and  range 
rate  measurement  noise  is  p  [10]. 

Since  target  motion  is  linear  in  Cartesian  coordinates, 
state  estimation  is  best  performed  in  this  coordinate  system. 
The  Kalman  filter  for  a  nearly  constant  velocity  target  mo¬ 
tion  assumption  is  described  in  [2],  Defining  the  state  as 
x  =  [  x  y  x  y  ]  ,  using  Hk  and  Pk  to  represent  the 
measurement  prediction  matrix  the  state  estimate’s  covariance 
matrix,  the  Kalman  gain  and  covariance  update  steps  are 
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The  covariance  matrix  of  the  converted  measurement  error  can 
be  partitioned  into  the  position  and  pseudo  range  rate  blocks 

[7] 


Sk+ 1 

—  Rk+i  +  Hk+iPk+i\k.H'k+i 

(3) 

wk+ 1 

II 

+ 

+ 

u 

(4) 

Pk+l\k+l 

—  Pk+l\k  —  Wk+\Sk+iWk+1 

(5) 

xk+l|k+l 

=  Xk+i|k  +  Wk+ 1  [zk  -  h  (xk+i|k)] 

(6) 

III.  Approaches 

Two  effective  techniques  that  predate  the  CMKFRR  are 
the  sequential  EKF  using  a  pseudo  measurement  and  the 
sequential  UKF.  Common  to  these  two  approaches  is  that 
range  and  bearing  are  first  converted  to  Cartesian  position. 
This  leaves  the  range  rate  as  the  only  measurement  component 
that  is  a  nonlinear  function  of  the  target  state. 

Various  approaches  have  been  developed  for  the  conversion 
of  range  and  bearing  to  Cartesian  position.  In  [14],  it  was 
shown  that  the  conventional  conversion  from  polar  to  Cartesian 
coordinates  introduces  a  bias  in  the  expected  value  of  the 
converted  measurement.  Various  remedies  to  this  bias  have 
been  proposed  [14],  [17],  [15],  [16],  [6]  and  applied  to  tracking 
with  range  rate  in  [7],  [13],  [11],  [12], 

The  range  rate  measurement  is  a  nonlinear  function  of  the 
target  state 


xx  +  yy 

\A2  +y2 


+  Wf 


(7) 


where  Wf  is  the  range  rate  measurement  noise. 

The  sequential  EKF  and  sequential  UKF  differ  in  their 
approach  to  handle  this  nonlinear  measurement.  The  sequential 
EKF  attempts  to  reduce  the  nonlinearity  between  the  state  and 
the  measurement  by  replacing  the  range  rate  measurement,  rm, 
with  a  pseudo  measurement  consisting  of  rmrm. 


Ceudo  =  Vrn  =  ^seudo  (x)+w^  =  xx  +  yy-  parar+wv 

(8) 

where  poyoy.  is  a  debiasing  term. 

The  use  of  this  pseudo  measurement  was  proposed  in  [9] 
and  applied  to  the  second  order  EKF  in  [7],  [11],  [12]. 
According  to  [13],  the  pseudo  measurement  has  disadvantages 
when  the  range  and  range  rate  measurement  noises  are  not 
statistically  independent  (as  is  the  case  for  certain  waveforms 
[1]).  For  these  cases,  use  of  the  UKF  has  been  proposed  [8], 
[13]  to  handle  the  strong  nonlinearities  with  the  use  of  range 
rate  instead  of  the  range/range  rate  product.  In  this  case  //„, 
is  simply  the  range  rate  measurement,  rm, 

Vm  =rm  =  h. '  (x)  +  Wf  =  .  +  Wf  (9) 

Vx  +  y 

The  sequential  EKF  and  UKF  process  the  position  measure¬ 
ments  first,  followed  by  processing  of  pseudo  measurement 
(8)  for  the  EKF  [7],  [11],  [12]  or  the  raw  range  range 
measurement  [8],  [13]  for  the  UKF.  In  order  to  process  these 
measurements  sequentially,  the  range  rate  based  measurement, 
V meud°  or  7mW’  must  first  be  decorrelated  from  the  position 
components  of  the  measurement.  This  is  achieved  as  follows. 


-Rconv 


Rpp  Rpp 
RPP  Rpp 


(10) 


where 


Rpp  = 


Rxx 

RVX 


RXV 

RVV 


,  RPP  =[  RXP 


RPP  ' 


(11) 


Let 

L  =  - Rpp  (RPP)-1  =  [  Li  L2]  (12) 


and 


B  = 


12x2  0 

L  1 


(13) 


By  pre-multiplying  B  on  both  sides  of  the  measurement 
conversion  equation,  a  new  measurement  prediction  function 
can  be  obtained  in  which  the  position  measurement  is  unmod¬ 
ified,  and  the  pseudo  range  rate  is  replaced  with  a  decorrelated 
pseudo  range  rate,  £ 


£  —  LiXm  +  L2ym  +  Pm  (14) 

with  the  corresponding  measurement  prediction  function 

pseudo  =  LlX  +  L2y  + xx  +  yy  (15) 

for  the  pseudo  range  rate  approach,  and 

he  —  L\x  +  L2y  -\ - ,  (16) 

vx  +  y 

for  the  raw  range  rate  approach. 

For  the  second  order  EKF  with  decorrelated  pseudo  range 
rate  measurements,  (3)  -  (6)  are  processed  for  the  converted 
position  portion  of  the  measurements.  The  state  estimate, 
xp  =  [a:  y  x  y  ]  ,  and  state  covariance,  P%+1  |fc+1, 
updated  using  the  position  measurement  only,  are  subsequently 
processed  using  the  decorrelated  pseudo  range  rate  measure¬ 
ment  in  a  second  order  EKF  [7], 

Similarly,  in  the  sequential  UKF,  (3)  -  (6)  are  processed 
for  the  converted  position  portion  of  the  measurements.  The 
state  estimate,  xp,  and  state  covariance  estimate,  P%+1  |fc+1, 
updated  using  the  position  measurement  only,  are  subsequently 
processed  by  the  decorrelated  range  rate  measurement  using 
the  second  order  unscented  transform  [13].  Sigma  points  are 
generated  using  the  state  and  covariance  estimate  that  has  been 
updated  by  the  position  estimates  and  then  passed  through  the 
nonlinear  function,  /T:iw,  to  provide  the  time  and  measurement 
update. 

IV.  New  Converted  Measurement  Approach  with 
Range  Rate  Measurements 

The  approach  used  in  the  recently  introduced  converted 
measurement  Kalman  filter  with  range  rate  (CMKFRR)  is  to 
convert  the  raw  measurement  of  range,  bearing  and  range  rate 
into  a  measurement  of  position  and  velocity  in  Cartesian  co¬ 
ordinates.  The  raw  measurement  is  converted  in  a  manner  that 
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is  unbiased  and  consistent,  and  that  allows  for  and  describes 
the  correlation  between  the  range  and  range  rate  measurement 
errors.  The  converted  measurement  error  covariance  estimate 
is  evaluated  at  the  prediction  (as  opposed  to  the  measurement) 
to  avoid  estimation  bias  [5], 

In  order  to  develop  this  conversion,  consider  the  inclusion 
of  a  non-informative  cross  range  rate  measurement,  c.  The 
conversion  function  to  Cartesian  is  therefore. 


zc  = 


T'm 

Urn 

=  D  (am) 

0 

Pn 

Vm, 

Cm 

cos  am  —  sm  am 
sin  am  cos  am 
0  0 

0  0 


where  D  is  the  direction  cosine  matrix, 

0  0 

0  0 

cos  am  —  sin  am 
sin  am  cos  am 


(17) 


(18) 


Cross  range  rate  is  non-informative  because  it  is  not  truly 
measured,  but  a  priori  knowledge  about  the  distribution  of  ex¬ 
pected  cross  range  rates  (based  on  knowledge  of  possible  target 
speeds)  can  be  used  in  calculating  the  converted  measurement 
error  covariance  as  describe  in  IV-B. 


A.  Estimation  of  the  Mean 

The  conversion  (17)  has  multiplicative  bias  of  a  factor  of 
e-cra/2  Ail  unbiased  version  of  the  measurement  conversion 
(17)  can  be  developed  as  an  extension  of  the  Unbiased 
Converted  Measurement  for  position  [15] 


T*  m 

Vm 

=  eCT°/2D  (am) 

0 

Pn 

Vm 

Cm 

B.  Estimation  of  the  Covariance 

For  convenience,  the  converted  measurement  error  covari¬ 
ance,  Re ,  will  be  developed  in  a  coordinate  system  along  the 
line  of  sight  (LOS)  to  the  target,  Pr,  and  then  converted  to 
Cartesian  coordinates,  i.e. 


RC  =  D  (a)  RrD  (a)'  (20) 


and  x"  is  the  nth  component  of  x. 

The  individual  components  of  Pr  evaluated  at  the  predic¬ 
tion  are  as  follows, 

=  (<*y 2 + ri1 + 4)  h  -  (<*y2 + ps)  h  <24) 

Rr  =  0  (25) 

7?r  =  (xrXr  +  Pr  +  pPr-Pr)  0+  -  (xrXr  +  ^R3)  (5+  (26) 
Rr2  =  ((ill 2  +  PS  +  4)  13-  -  ((A)2  +  PS)  S-  (27) 

Pr  =  (44  +  pr)  0-  -  (44  +  pr)  s-  (28) 

Rf  =  ((sty1 2 + Rr3 + 4)  i3+  +  (<*y2 + ps + 4)  e- 

-  ((>Sr)2  +  PS)  s+  -  ((St4R)2  +  PS)  s-  (29) 


where 


"d±  2  L 


lie 


-2  at  -2ai 


1  =b  e 


-2ai 


and  is  the  approximate  bearing  variance  of  the  predicted 
track  estimate  based  on  a  linearization  of  Pr, 


G 


2 

cat 


Pj2 

(*r)2 


(30) 


x^  is  the  ?rth  component  of  Xr  and  -Pr"1  is  the  (nm)  element 
of  .Pr.  The  value  of  a, 3  used  in  (29)  is  set  based  on  an  a  priori 
estimate  of  the  standard  deviation  of  target  cross  range  rate. 

Since  the  cross  range  rate  measurement,  cm,  is  non- 
informative,  the  remaining  components  of  the  measurement 
noise  covariance  in  the  LOS  coordinate  system,  Rr  (e.g.  R)) , 
R  f )  are  infinite.  It  is  therefore  useful  to  deal  with  the  inverse 
of  Rr 


Rr  1 


(43’1:3)_1  0 
v  '  0 
0  0  0  0 


(31) 


Since  the  inverse  of  the  direction  cosine  matrix,  D  (am),  is 
its  transpose,  the  measurement  noise  covariance  for  (19),  Rc, 
is 


Rc'1  =D(at)RR~1D(aty  (32) 


The  calculation  of  the  components  of  Rq  requires  the  true 
target  velocity  and  position.  Since  these  are  not  available  in 
practice,  the  evaluation  is  performed  at  the  predicted  target 
state,  xa_|_i|£. 

First  the  predicted  target  state  and  covariance  are  rotated 
into  the  estimate’s  LOS  coordinate  system: 


xr  =  D(at)'xk+i \k 

(21) 

Pr  =  D  (at)' Pk+1\kD  (at) 

(22) 

where  the  predicted  target  bearing  is 

(23) 

\xfc+i|fc  / 

The  inconsistency  in  the  use  of  a 3,  and  the  rational,  requires 
explanation.  The  value  in  (29)  influences  the  Kalman  gain  for 
the  rm  measurement  and  an  a  prior  estimate  of  a 3  is  used  to 
improve  the  consistency  of  the  tracker.  For  the  components  of 
Rr  that  influence  the  Kalman  gain  for  cm,  03  is  set  to  infinity 
(or,  equivalently,  the  components  of  R){  1  set  to  zero).  This 
is  to  ensure  that  the  tracker  is  not  biased  towards  the  value 
substituted  for  cm,  since  it  is  not  truly  measured. 

The  consistency  of  the  conversion  method  was  examined 
using  the  Normalized  Error  Squared  (NES)  [2]  and  shown 
to  be  consistent  in  [4],  Note  that  although  the  converted 
measurement  has  dimension  4,  the  expected  NES  [2,  eq. 
(10.4.3-26)]  is  3,  since  velocity  errors  along  the  cross  range 
are  multiplied  by  zero. 
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Unfortunately,  Rc  1  is  not  invertible,  so  Rc  is  not  available 
for  use  directly  in  the  Kalman  filter  gain  calculation  (3).  It  can 
however  be  used  in  the  information  form  of  the  Kalman  filter, 
described  in  V-A. 


V.  Application  to  Tracking 


A.  Information  Form  of  the  Kalman  Filter 

The  information  form  of  the  Kalman  filter  [2]  propagates 
the  inverse  of  the  state  covariance  and  uses  the  inverse  of 
the  measurement  error  covariance.  This  allows  the  use  of 
Rc  1  (32)  directly,  in  place  of  Rc,  which  is  unavailable.  The 
calculation  of  the  Kalman  gain  in  the  Kalman  filter  (3)  -  (4) 
is  replaced  with 


Wk+1  = 


PZ 


H'R7},H 


H'Rkh 


fc+l|fc  ^ 

and  the  state  covariance  update  (5)  is  replaced  with 

Pk+1\k+1  =  [P^llk  +  H'Rfl1H]-1 


(33) 


(34) 


B.  Converted  Measurement  Kalman  Filter  with  Range  Rate 

With  the  use  of  the  measurement  conversion  function  (19), 
each  component  of  the  state  (for  the  nearly  constant  velocity 
model)  is  observed  directly.  When  applied  to  the  information 
form  Kalman  filter,  one  has  H  as  the  identity  matrix.  The 
converted  measurement  is  therefore  linear  with  respect  to 
the  target  state,  eliminating  the  need  for  the  extended  (or 
unscented)  Kalman  filter. 

The  Converted  Measurement  Kalman  Filter  with  Range 
Rate  (CMKFRR)  is  implemented  as  follows: 

1)  Convert  the  raw  measurements  of  range,  bearing  and 
range  rate  to  Cartesian  position  and  velocity  with  (19), 
using  cm  =  0,  and  use  the  result,  z  =  zy,  in  (6). 

2)  Use  the  information  form  of  the  Kalman  filter  (33)-(34) 
with  f?-1  =  Rc1  from  (32). 

3)  Set  the  measurement  prediction  matrix,  H  =  /4X4,  in 
(33H34). 

4)  Let  h  (x)  =  x  in  (6). 


To  allow  for  direct  comparison,  all  of  the  existing  trackers 
were  implemented  with  the  conversion  of  range  and  bearing  to 
Cartesian  coordinates  using  the  method  described  in  [6],  [12], 
The  conclusions  hold  for  other  conversion  methods. 

Measures  of  performance  include  mean  square  error  (MSE) 
for  the  target  position  and  velocity  estimates.  An  additional 
measure  of  performance  is  the  tracker  consistency  based  on 
the  Average  Normalized  Estimation  Error  Squared  (ANEES) 
[2],  The  ANEES  of  a  consistent  estimator  is  close  to  1.  Tracker 
consistency  is  important  not  only  for  analysis  of  results, 
but  also  for  measurement  to  track  association  in  multitarget 
tracking  scenarios  in  clutter. 

The  tracking  scenario  is  set  up  as  follows: 

1)  True  target  range,  r,  normally  distributed  with  mean 
4,000m  and  standard  deviation  of  30m. 

2)  True  target  bearing  uniformly  distributed  from  —  7r  to  tt 

3)  True  target  heading  uniformly  distributed  from  —  7r  to  tt 

4)  True  target  speed  distributed,  scaled  by  lOm/s 

5)  Sensor  range  accuracy,  ay  =  30m 

6)  Sensor  bearing  accuracy,  oa  =  1°,  2.5°,  5°,  8°  and  16°. 

7)  Sensor  range  rate  accuracy,  oy  =  O.lm/s 

8)  Correlation  between  range  and  range  rate  errors,  p  = 
-0.2. 

9)  a,,  in  (29)  set  to  10  m/s 

Fig.  1  shows  the  results  of  5,000  Monte  Carlo  runs  of  the 
trackers.  In  each  of  the  test  cases,  the  proposed  CMKFRR 
achieved  performance  that  was  equal  to  or  better  than  the 
existing  methods.  For  small  angle  error,  the  performance  of 
the  CMKFRR  matched  the  existing  methods  (results  overlap 
on  plots),  and  all  trackers  were  fairly  consistent.  As  the  angle 
accuracy  degraded,  the  CMKFRR  performance  was  better  in 
terms  of  MSE,  and  considerably  better  in  terms  of  consistency. 
Even  for  severely  degraded  angle  accuracy,  <ja  =  16°,  the 
CMKFRR  maintained  consistency. 

VII.  Conclusion 


VI.  Evaluation 
A.  Performance  Comparisons 

The  performance  of  the  proposed  Converted  Measurement 
Kalman  Filter  with  Range  Rate  (CMKFRR)  has  been  evalu¬ 
ated  with  respect  to  the  current  state-of-art  techniques.  The 
CMKFRR  was  compared  to 

1)  CMKF  using  range  and  bearing  measurements  only 
(POS) 

2)  Sequential  EKF  using  pseudo  range  rate  (i.e.  range, 
range  rate  product)  as  described  in  III  (SEKF) 

3)  Sequential  UKF  using  range-rate  as  described  in  III 
(SUKF) 

4)  Posterior  Cramer-Rao  lower  bound,  as  defined  in  [18], 
for  range  and  bearing  measurements  only  (PCRLBPOS) 

5)  Posterior  Cramer-Rao  lower  bound,  as  defined  in 
[18],  for  range,  bearing  and  range-rate  measurements 
(PCRLBPOSRR) 


When  tracking  with  measurements  of  range,  bearing  and 
range  rate,  various  filtering  techniques  have  been  proposed. 
For  cases  with  poor  bearing  accuracy,  the  valid  approaches 
have  been  limited  to  nonlinear  filters,  such  as  the  EKF  and 
UKF.  This  work  has  shown  that  a  linear  Kalman  filter  can 
be  employed  to  handle  this  estimation  problem  by  using  a 
new  converted  measurement  technique  and  the  information 
form  of  the  Kalman  filter.  The  conversion  process  avoids 
conversion  bias  by  using  an  unbiased  converted  measurement, 
and  precludes  estimation  bias  by  evaluating  the  converted  mea¬ 
surement  error  covariance  at  the  prediction.  Simulations  show 
that  this  linear  Kalman  filter  has  improved  MSE  performance 
over  all  the  state  of  the  art  trackers,  including  the  sequential 
EKF  using  pseudo  range  rate  and  the  sequential  UKF.  This 
new  approach  is  recommended  for  consideration  in  active 
radar  or  sonar  systems  that  include  measurements  of  range 
rate. 
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